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A SIMPLE  CLOSED-FORM  SOLUTION  OF 
A POSITION-FIXING  PROBLEM 


INTRODUCTION 

The  problem  of  finding  the  location  of  an  object  is  a part  of  the  age-old  navigation  prob- 
lem. Since  electronics  was  introduced,  accurate  range  measurements  became  possible,  and,  if 
'he  range  difference  is  known  from  an  object  to  several  transmitter  stations  whose  positions  are 
accurately  known,  the  location  of  the  object  can  be  determined  by  triangulation.  Examples  of 
systems  which  use  range  differences  are  Loran  and  Omega.  In  radar  systems,  ranges  to  an  ob- 
ject can  be  found  by  either  the  object  receiving  echoes  from  known  locations  or  by  several 
known  locations  having  radars  receiving  echoes  from  the  object.  The  ranges  are  known  in  ei- 
ther case.  These  could  be  converted  to  range  differences  to  correspond  to  the  same  problem  as 
Loran  and  Omega.  However,  this  is  not  necessary. 

A simple  means  of  obtaining  the  object  position  is  described  in  this  report.  (An  error 
analysis  is  planned  for  a future  report.)  The  solution  is  in  closed  form  and  involves  no  more 
than  simple  algebra  (adding,  subtracting,  multiplying,  dividing,  and  taking  square  roots)  and  the 
evaluation  of  a few  trigonemtric  functions  (sin,  cos,  arctan).  The  solution  proceeds  in  several 
steps.  First  all  stations  of  known  location  (which  are  noncoplaner)  are  specified  in  a common 
Cartesian  coordinate  system  with  the  origin  located  at  one  of  the  station’s  positions.  This  coor- 
dinate system  is  then  rotated  such  that  a special  form  of  the  equations  are  obtained.  The 
object’s  location  is  then  found  by  simple  algebra,  and  this  solution  is  then  passed  through  the 
inverse  coordinate  transformations  to  obtain  the  object’s  position. 

STANDARD  COORDINATE  SYSTEMS  AND  TRANSFORMATIONS 

Before  the  solution  can  be  obtained,  a means  of  describing  the  stations  and  object's  posi- 
tion on  the  earth  is  reviewed.  Figure  1 shows  several  earth-based  coordinates.  The  definition  of 
the  geocentric  coordinates  ( X . Y.  2),  spherical  representation  (latitude  #,  longitude  X,  and  ra- 
dius vector  f>  (earth’s  radius  plus  object  height  above  earth)),  and  local  coordinates  (x,  y.  ;)  are 
well  known  and  are  not  elaborated  on  further. 

The  transformations  leading  from  one  coordinate  system  to  another  are  as  follows.  To 
convert  from  one  local  coordinate  system  to  the  geocentric  coordinates,  the  transformation 
used  is  I 


X 

X 

Y 

« T 

y 

Z 

z 

Manuscript  submillcd  March  4.  1977 


1 


f 


B II  CANTRELL 


EARTH  S SPIN  AXIS 


GREENWICH 
OBSERVATORY  - 


.Oi* 


I EARTH'S  CENTER- 


where 


Fig.  I ~ Coordinate  systems  defined  on  the  earth 


cos  A —sin  0 sin  A cos  0 sin  A 
0 cos  0 sin  0 

—sin  A —sin  0 cos  A cos  0 cos  A 


The  inverse  is  found  by 


where 


f>  cos  0 sin  A 
f>  sin  0 
p cos  0 cos  A 


X 

T Y - V, 
Z 


The  transpose  of  T denoted  by  7”  is  also  the  inverse  of  T. 

FORUMLATION  OF  THE  PROBLEM  OF  POSITION  FIXING  BY  RANGING 

It  is  assumed  that  the  positions  denoted  by  (»,,  A,,  p,)  for  / =1  through  4 for  four  sta* 
lions  and  the  ranges  for  i — 1 through  4 from  these  four  stations  to  an  object  of  unknown  lo- 
cation (0p,  A„,  pp)  arc  known.  The  problem  is  to  find  a simple  means  of  obtaining  the  objects’ 
unknown  location  (0p,  \p.  pp). 
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First  the  coordinates  of  the  stations’  position  are  converted  to  a C rtesian  coordinate  sys- 
tem. Specifically,  the  geocentric  coordinates  are  used,  and  the  coordinate  transformation  is 


The  four  equations  describing  the  ranges  from  each  of  the  four  stations  to  the  unknown  object 
are 


<*,  -x,)2  + (yp  — y,)2  + (Zp  -z()  =r} 


1,  ....  4. 


(1) 

Z„).  How- 


The  simultaneous  solution  of  these  four  equations  yields  a unique  position  (Xp,  Yp 
ever  the  equations  in  the  form  of  (1)  are  difficult  to  solve.  The  solution  discussed  subsequently 
relies  on  a coordinate  transformation  to  place  the  equations  in  an  easily  solvable  form.  The 
solution  is  then  transformed  back  to  obtain  the  desired  answer. 

SOLUTION 

The  first  transformation  in  obtaining  the  solution  is  to  transform  the  geocentric  coordi- 
nates of  the  station  to  the  local  coordinates  of  one  of  the  stations  such  that  it  is  the  origin  of 
the  new  Cartesian  coordinates.  This  is 


where 


and 
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The  next  coordinate  transformation  is  a rotation  such  that  station  I is  the  origin,  station  2 lies 
on  the  new  x axis  ( s axis),  and  station  3 lies  on  the  new  xy  plane  (st  plane).  The  equation 
describing  the  rotation  is 
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where 
Q - 

in  which 


cos  a cos  fi 

—sin  a cos  y — cos  « sin  fi  sin  y 
sin  « sin  y — cos  a sin  0 cos  y 


sin  a cos  fi 

cos  « cos  y — sin  a sin  fi  sin  y 
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x, 

p , cos  0,  sin  X( 

1 

y, 

= t/(  = 

p,  sin  0, 

z, 

p,  cos  0,  cos  X ( 

3 


B H.  CANTRELL 


and 

x3  cos  a sin  /)  + y3  sin  a sin  /3  — z3  cos  fi 

y = tan  > ; . 

x3  sin  a — cos  a 

The  details  of  the  transformation  (2)  are  discussed  in  Appendix  A.  The  transformations  used 
so  far  can  be  collected  as: 


x, 

1, 

= QTy 

y, 

w, 

Z, 

-V,,  / = 1 4. 


where 


Equations  (1)  after  transformation  are  in  the  form 


X, 

p, 

cos  0,  sin  A, 

y, 

- 

p, 

sin  0 , 

Z, 

Pi 

cos  0,  cos  A, 

Up ) 2 + ('p  ) 2 + <«p  ) 2 " 'i2  • 


(ip  -S2)2  + I2  + (u„)2  = r 2 . 

(Sp  - s3  )2  + U„  - f3  )2  + m2  = r 2 , 


and 


(sp  ~s4)2  + (ip  -r4)2  + ( Up  — t/4  ) 2 = r4  . 

These  equations  can  easily  be  solved  for  the  unknown  position  ( sp , rp,  up).  From  (4) 


1 1 + «p  = r\  ~ s2- 

This  is  substituted  into  (5),  yielding 

sp  - 2V 2 + s2  + ri2  “ sp  “ r2 - 


which  can  be  solved  for 


.2  _ ,2  . -2 

r,  r2  + s2 


2 s1 


Then  (8)  is  substituted  into  (4)  and  (6),  yielding 


ti  + ui 


rT-  — ^ 


and 


Eliminating  u yields 


Up  - f3)2  + Up  = rf  - (*-  - s3  )2. 
s|  + r,2  - e2  - rj  + (e  - s3  ) 2 

Finally  (8)  and  (9)  are  substituted  into  (4),  yielding 

Wp  “ ± -e2-^. 


-/ 
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Equation  (7)  is  used  to  determine  which  sign  on  (10)  should  be  used.  The  sign  is  used  which 
most  closely  makes  (7)  to  be  true.  The  solution  involves  no  more  than  simple  algebra  to  con- 
struct and  only  requires  addition,  substraction,  multiplication,  division,  and  square-root  opera- 
tions for  implementation. 

The  solution  can  be  interpreted  geometrically  as  follows.  Equations  (4)  through  (7)  are 
equations  of  spheres.  The  intersection  of  two  spheres  yields  a circle,  and  the  intersection  of  a 
circle  and  a sphere  yields  two  points.  The  two  points  intersecting  a sphere  yield  a singular 
point.  The  last  equation  deciding  on  the  sign  of  up  may  not  be  necessary  if  other  information  is 
available. 

After  the  solution  the  inverse  transformations  are  performed  to  move  the  coordinates 
back  to  the  original  frame  of  reference.  The  inverse  of  (3)  is 


SP 

Yp 

= TxQ' 

<p 

zp\ 

“p 

The  latitude,  longitude,  and  radius  vector  for  the  object's  position  is  then  given  by 
»P  -tan'1  {Ypty/X}  + Yj), 

Kp  - tan'1  (Xp/Zp), 
and 

p,  = V*p2  + y}  + Z2n- 

Flow  Chart 

The  computations  required  for  finding  an  object's  location  by  knowing  the  range  to  four 
stations  of  known  location  is  best  summarized  with  a flow  chart  (Fig.  2).  The  Cartesian 
representation  of  the  geocentric  coordinates  U,  of  the  stations  are  found,  and  the  coordinates 
are  rotated  by  7j  and  translated  by  V\  so  that  the  origin  of  the  new  coordinates  is  at  station  1. 
The  rotation  matrix  @is  computed  so  that  stations  on  the  new  coordinates  have  station  1 at  the 
origin,  station  2 on  the  new  x axis,  and  station  3 on  the  new  xy  plane.  The  coordinates  of  the 
object  are  obtained  with  simple  algebra.  Finally  the  object's  position  is  passed  through  the  in- 
verse transforms  to  obtain  its  position  in  terms  of  latitude,  longitude,  and  radius  vector. 


SUMMARY 

A closed-form  solution  of  the  problem  of  obtaining  the  location  of  an  object,  given  the 
ranges  to  it  from  four  known  locations,  was  achieved.  The  method  requires  only  simple  alge- 
bra (addition,  subtraction,  multiplication  and  division)  and  the  simple  evaluation  of  trig- 
nometric  functions  such  as  sin,  cos,  and  arctan.  Only  three  stations  are  required  for  the  solu- 
tion if  some  other  a priori  information  is  available  such  as  height  above  the  earth  or  azimuth 
measurement.  An  error  analysis  is  planned  for  a future  report. 
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Fig  2 — Flow  chart  of  compulations 
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Appendix  A 

DETAILS  OF  THE  COORDINATE  ROTATION  AS  GIVEN  BY  EQ.  C) 

Station  1 is  defined  at  the  origin  initially.  The  problem  is  to  first  place  station  2 on  the 
new  x axis  after  rotation.  First  a coordinate  rotation  by  angle  alpha  about  the  r axis  and  then  a 
rotation  by  angle  beta  about  the  new  y axis  is  obtained.  This  two-step  rotation  is 


' COS  a COS  IS 

sin  a cos  fS 

sin  /3|  xi 

y,  = —sin  a 

cos  rt 

o y, 

—cos  a sin  IS 

—sin  « sin  fS 

cos  fS  , 

*/ 

/ 

Placing  the  coordinates  :2 ^ f°r  s,ati°n  2 into  (Al),  we  desire  y2  and  :2  t0  zero  by 

definition.  This  yields 

0 — — x2  sin  a + y2  cos  a (A2) 


0 = — .v2  cos  t*  sin  IS  — y2  sin  a sin  fS  + z2  cos  fS.  (A3) 

Solving  (A2)  for  alpha,  one  obtains 

a =tan~'  (y2/x2).  (A4) 

Substituting  (A4)  into  (A3),  one  then  obtains 

fi  = ‘an-1  — -====.  (A5) 

y/x2  + >2 

Finally  the  new  coordinates  of  station  3 are  required  to  not  have  a z component.  A rotation 
about  the  x axis  by  angle  gamma  is 

*,]  (I  0 0 x\ 

t(  = 0 cos  y sin  y y(  . (A6) 

0 -sin  y cos  y 

i [z/ 

Placing  the  coordinates  of  (jfj,  y3,  z2)  of  station  3 into  (A6)  and  setting  m,  — 0,  one  obtains 
0 = — >3  sin  a + r3  cos  a 
or 

y ~ tan-1  (rj/yj  ). 
which  is  from  (Al) 

-x-,  cos  « sin  IS  — y2  sin  « sin  fS  + r3  cos  /S 

y - tan  1 : ; • (A7) 

— x3  sin  « + y3  cos  « 

The  coordinate  transformation  Q is  obtained  by  combining  (Al)  with  (A6),  with  the  angles  be- 
ing given  by  (A4),  (A5),  and  (A7). 
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